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ABSTRACT 

This work describes two algorithms for computing the 
angular rate and attitude in case of a gyro failure in a 
spacecraft (SC) with a special mission profile. The source of 
the problem is presented, two algorithms are suggested, an 
observability study is carried out, and the efficiency of the 
algorithms is demonstrated. 

KEY WORDS 

Attitude Determination, Angular Rate Computation, 

Kalman Filtering, Sensor Failure. 

1. INTRODUCTION 

Consider a spacecraft (SC) that has two two-axis 
gyroscopes, which are arranged such that one input axis of 
one of the gyros is aligned along the body x-axis and the 
other input axis is aligned along the body z-axis. The input 
axes of the second gyro are aligned along the body y and z- 
axes. If only one gyro fails then the rate about two body 
axes is still measured; namely, about the z-axis and one of 
the other two. The SC considered has also a vector Fig 
measuring devise like a sun-sensor. It carries also a second 
vector-measuring device but it is assumed that this sensor 
failed too. The angular motion of the SC consists of two 

rotations as described in Fig. 1. One rotation, at 4 radian 
per second, is about a fixed line in inertial space, and the 
other, at X radian per second, is about the satellite z-axis. 

The body z-axis is tilted by a radians with respect to some 
line fixed in inertial space. It is require that in the even t 
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1: The Geometry and Coordinate Systems Describing 
the Angular Motion Components of the Spacecraft. 

of a failure of one of the gyros, the angular velocity and 
attitude of the SC can still be fully determined. There were 
two cardinal questions concerning such failure; namely, can 
the full angular rate vector and attitude be determined, and 
if it can be, how to do it. An answer to the first question is 
supplied by an observability check; that is, if the system 
state vector, containing the attitude and angular rate vector, 
is observable with one gyro and one vector measurement, 
then it is possible to estimate the rate and attitude of the 
SC. In this case what is left to do is to devise an algorithm 
that does it. These two questions are addressed in this work. 
As will be shown in the ensuing, the answer to these 
questions is positive. Two algorithms are presented in this 
work, one of which may supply the rate and attitude of the 
SC when one gyro fails. 
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2. BODY ANGULAR KINEMATICS 


The body angular rate and attitude definitions are presented in 
Fig. 1 in terms of three Euler angles. In order to describe the 
SC motion and the associated measurements we define four 
coordinate systems. The first system is the inertial coordinate 
system (designated by I). The center of this system is at the 
origin of the SC coordinates, its x-axis and z-axis point 
arbitrarily in inertial space. A rotation by the angle about 
the z-axis yields a first interim coordinate system, which we 
denote by /. A second rotation by the angle 5 about the y-axis 
of this interim coordinate system yields the second interim 
coordinates, which we denote by 2. Finally, a rotation about the 
z-axis of the latter system by A, results in the body coordinates, 
which we denote by b. Note that, for simplicity, only the z-axis 
of the body system is shown in Fig. 1. The SC rotates about 

two axes. One rotation, at the rate of , is about the Z\ axis, 

and the other, at the rate of X , is about the body z-axis. The 
sum of these rotation rates in body coordinates is as follows: 

G) x = 4 sin 5 • cos X + 5 sin X 

co y = -£ sin 8 -sin A. + 5 cos A, (1) 

g) 2 =* -£cos5 + A. 

These rate components are inertial rates resolved in body 
coordinates. We note that since 5 is designed to be constant the 
design value of the derivative of 5 is: 

5 = 0 (2) 

The transformation matrix from inertial to body coordinates is: 

c£,c5cA. + s^sA. -s^cScA. + c^sX -s5cX 
D'= -c£c5sA.+ s^cA. s^cSsA* + ci;cA. sSsA, @) 
c^s5 -s^s5 c5 

The corresponding quaternion can be extracted best when using 
the algorithm presented in [1]. 

The Vector Measurements 

We need to determine the relationship between the vector 
measurements that are measured by a Sun Sensor (SS), for 
example, and the angles £ , 5 and X that determine SC 
attitude. To do that we turn to Fig. 2, which depicts the 
orientation of the sun-sensor boresight in body coordinates. The 
SS reads the tangent of the angles a and |3 . We wish to 
express the readings of these tangents as functions of the angles 
£ , 5 and A. defined in Fig. 1. To do that we define (Z ( ) b and 

(Z i ) i . The column matrix (Z^ contains the components of the 
vector Z ( when resolved in the body coordinates, and, 
similarly, the column matrix (Z i ) / contains the components of 
the vector Z i when resolved in the 



Fig. 2: Definition of the Sun Direction 

inertial coordinates. We denote the components of the 
former by a x , a y and a 2 . It is easy to see that the 

components of (Z i ) j are 0, 0, and 1. Thus 

(Z,):»0. a y a,] (4 a) 

and 

(Z^=[0 0 1] (4.b) 

Obviously 

(Zj) b = D* (Z,), (5) 

From the last three equations and Eq. (3) we obtain 



hence 

a x = -s5cA 

a y = s5sA. (7) 

a z = c5 

therefore 


a 

tan (3 = — = - tan 5 • cA 
a 

( 8 ) 

a 

tan a = — = tan 5 • sX 
a 

z 

Note that tana and tanp are independent of ^ . An 
inspection of Fig. 2 reveals that this is an expected result. 
Since tana and tanp are measured quantities, the last two 


equations contain only two unknowns, therefore we can solve 
for the angles 5 and X. For this reason even if the 
measurements contain errors we can still find these two 


angles by proper filtration as long as the measurements are 
unbiased. In order to fully know the SC attitude we need to 
know ^ too. If the gyros mounted on the inertial coordinates 


z-axis introduce no bias, then a proper integration of their 
measured outputs will yield £, and thus we can determine the 
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SC attitude from the measurements obtained from these gyros 
and the SS. If the gyro measurements contain bias then we ask 
ourselves whether the system is observable; that is, whether the 
SC angular dynamics (Euler) equation may add information 
with which we can still observe % and thus completely 

determine the attitude. To answer this question we have to 
design an estimator and examine the observability of the 
system used by the estimator. This is done next. 

3. THE FILTERS 

111.1 Filter I 

111.1.1 Dynamics Model 

In this estimator (filter) we convert the SS measurements to a 
vector measurement, which is then connected to the quaternion 
of the SC. The dynamics model of Filter I was developed in 
[2]. Using 



define the system dynamics as 

"®i ri" ! [(i® + h)x] or«i + rr , (T-h)] + rw.i (10) 

.qj L tQ oJLqJ [ o j [wj 

where [gx] is the cross product matrix of a general vector g, 
accounts for the inaccuracies in the modeling of the SC 
angular dynamics, and w q accounts for modeling errors of the 
quaternion dynamics. Both w a and w q are zero mean white 
noise vectors that are uncorrelated with one another. 

III.l. 2 Measurement Equations 

The measurements are the tangent of the angles a and (3 , 
measured by the SS and shown in Fig. 4, and the z and either 
the x or the y component of the body rate measured by one of 
the SC gyros. The measured quantities are contaminated by 
noise so they are not the true values but rather, a m , (3 ra , © zm 

and either 0) x m or © y m , depending which gyro failed. 

III.1.2.1 Sun Sensor Measurement 

Using the two measured angles we compute a unit vector in the 
assumed sun direction as follows [4, p. 226] 



In reality tanp m and tana m contain noise; however, in the 
filter we approximate the b m measured vector as the true 
vector to the sun and a simple additive zero mean white noise 
vector, V b ; that is, 


b m =b + v b (12) 

where b is the true unit vector in the true direction to the 
sun. The logic behind this simplification is that if in tests 
the filter yields satisfying results then the approximation 
is justified. Let r denote the measured sun-vector 
expressed in the reference coordinate system (this vector 
is taken from the almanac) then the relationship between 
the two vectors is expressed by 

b = Dr (13) 

where D is the direction cosine matrix that transforms 
vectors from the reference to the body coordinates. From 
the last two equations we obtain 

b m =Dr + v 6 (14) 

It is well known that D is the following function of the 
quaternion elements [3, p. 414] 

<3? -42-43 +q? 2(q,q 2 +q 3 q 4 ) 2(q,q 3 -q 2 q 4 ) 

D = 2(q,q 2 -q 3 q 4 ) -q?+q 3 -q 3 +q 4 2(q 2 q 3 +q,q 4 ) 

2(q,q 3 +q 2 q 4 ) 2(q 2 q 3 -q,q 4 ) -qf-q 2 +q 3 +q 4 

...(15) 

then using this relationship between D and q, Eq. (14) 
can be written as 



were 

q t r, +q 2 r 2 +q 3 r 3 -q 2 n -q«r 3 -q 3 r, +q.r 2 + q,r 3 q 4 r t + q 3 r 2 -q 2 r 3 ' 
H k (r,q)= q^-q^+q^, q,r, +q 2 r 2 +q 3 r 3 -q 4 r, -q 3 r 2 +q 2 r 3 -q 3 r, + q 4 r 2 +q,r 3 

q* -q^ -q«r 3 q^! +q 3 r 2 -q 2 r 3 q,r, +q 2 r 2 + q,r, q 2 r, -q t r 2 + q 4 r 3 

...(17) 


This is the measurement equation associated with the SS 
measurement. 

III.1.2.2 Gyro Measurement 

Let us assume that the gyro that measures rates along the 
x and z axes is the gyro that is still operating. The x and z 
axes rate measurements can be written as 


co =co , + v„ 

z,ra z ci) 


(18) 


where co, and co, are the true rates, and v_, and V__ 

A Z / UiX (JJZ 

are scalar zero-mean white measurements noise. Define 



then from the last two equations we obtain 



( 20 ) 


We denote the measurement vector by co ra where, 
clearly, co^ = [co xm co zm ]. Similarly we denote the noise 


vector as by where v^ = [v ax v m J. Obviously, if 


the other gyro is the one that is still operating, then the x 
component in Eqs. (18-20) has to be replaced by they. 
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IIL1.2.3 The Combined measurement 

Combining Eqs. (21) and (24) we obtain 



'o H b (r,q)l 

CO 

4_ 

V 

1 

o 

s 

X 

.q_ 

T 

_v 


( 21 ) 


This is the combined measurement model for simultaneous 
measurement of the operating two-axes gyro and the SS. 

III.2 Filter II 
ffl.2.1 Dynamics Model 

In this filter we make use of the kinematics rule governing 
the rate of change of the sun vector. It is known that 

Dr = b + coxb (22. a) 

hence 

b = [bx]o> + Dr (22. b) 

As mentioned earlier, the vector r is known from the 
almanac, therefore r is known too. Consequently we can 
treat Dr as a deterministic forcing function. In our case r is 
the vector from the SC to the sun. For the SC trajectory this 
vector changes extremely slowly, therefore we can neglect 
the term in r and use 

b - [bx]co (22.c) 

Augmenting Eq. (22.c) with the dynamics of Filter I yields 


tb 


Y'[(Iw + h)x] 

0 

o' 

to 


r'(T-h) 



q 

= 

±Q 

0 

0 

q 

+ 

0 

+ 

w , 

b 


[bx] 

0 

0 

b 


Df 




Remark: The state vector in Eq. (23) includes the sun 
vector b even though b is a measurement. Indeed, 
formally, in order to compute the rate and attitude one can 
numerically differentiate one of the components of b , and 
use it in one of the following equations (which are the 
components of Eq. (22. c)) 

b x = a> x b y -co y b z 

b y =°) x b z -ca 2 b l (24) 

b = © b — co b 

z y x x y 

together with the gyro-measured (0 2 , and either co* or co y 

(depending which gyro is intact) to solve for the missing 
component of <0 . Then use the full <0 as ‘measurements’ 
in an estimator whose dynamics model consists of the first 
two matrix equations in Eq. (23). This, however, requires 
numerical differentiation, which introduces noise. To avoid 
differentiation we apply the estimation approach [4] 
according to which we add to Eqs. (22. c) the differential 
equations of the variables that we want to estimate, thereby 
forming Eq. (23), and then use a Kalman filter to estimate 
those variables. 

HL2.2 Measurement Equations 

The measurement equations of Filter II are quite simple. 
The vector measurement of Eq. (16) is replaced by the 


following simple equation. 

b m =[0 0 I] 


(0 

q 


+ V v 


(25) 


Eq. (20) stays the same; therefore, the augmented 
measurement equation for Filter II becomes 






(0 


X" 


■ 0 

0 

f 


v b 


= 




q 

+ 


O) 


H 

0 

o_ 



V 

L_ m _] 

1 

L co 



b 


L. «a _J 


(26) 


4. OBSERVABILITY TESTS 

Before carrying on an observability test it is necessary to 
specify the kind of filter that was used in this analysis. 
The filter that was used here is the PSELIKA (Pseudo- 
Linear Kalman) Filter [5]. The idea on which this filter is 
based is as follows. Suppose that the non-linear 
dynamics and measurement equations of a non-linear 
system can be decomposed in the following way 

x = F(x)x + Bu + w (27.a) 

y = H(x)x + v (27.b) 

If F(x) is close enough to F(x) and H(x) is close 
enough to H(x) (note that we do not assume that x is 
necessarily close to x) then instead of the unknown 
matrices F(x) and H(x) we can use respectively F(x) 
and H(x) , which are known along the estimation 

process, and apply the linear Kalman filter algorithm to 
the measurements using the models 

x = F(x)x + Bu + w (27.c) 

y = H(x)x + v (26. d) 

In the observability analysis we use F(x) and H(x) 
where x is taken from simulation. The logic of this test 
is as follows. If when using F(x) and H(x) in the 
analysis the latter indicates that the system is not 
observable under these favorable conditions then there is 
no sense to try to estimate the state vector x of the 
system. If, on the other hand, the analysis indicate that 
the system is observable, then observability and therefore 
estimability are not assured, but it make sense to design 
an estimator, try to estimate x and see if this could 
indeed be done. 

The observability of the system models used by the two 
filters was examined using the following analysis. 
Consider O k , the transition matrix, which corresponds to 
F, the dynamics matrix, of either Eq. (10) or Eq. (23). 
This matrix transforms the system state vector at time 
t k , to x k+l , the state at time t k+1 . If at a certain time- 
point, t m , the initial state, denoted by x 0 , can be 
computed, then, for our purposes, the system is 
observable. Adopting the common approach to the proof 
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of complete observability of a discrete linear system, we 
express the first m measurements as follows 


yj= H j( x i) 


i=0 


j = 0, 1, m 


(28) 


where <X> 0 (x 0 ) = I n . Form the matrix equation 


"y." 


H„(x 0 ) 

y. 


H,(x,)<D 0 (x 0 ) 

y 2 

= 

H 2 (x 2 )<D t (x,)<J> 0 (x 0 ) 

_y„_ 




(29) 


(Note that in Filter II H is not a function of the state. That is, the 
measurement equation is linear from the start.) If there are n 
independent rows in the right hand side matrix (the observability 
matrix) in Eq. (29), where n is the number of states, then, of 
course, x 0 can be solved for, hence the state is observable. 

The observability test of Filter I reveals that the rank of the 
observability matrix for this filter becomes 7, and since the filter 
state is 7 too, the system is observable. It means that there are 
good chances that Filter I can estimate both the missing angular 
rate component as well as the attitude of the SC when one gyro 
fails. We note though that the measurement equation of Filter I 
is only pseudo-linear and not truly linear. This may cause a 
problem even though the observability test indicates that the 
state is completely observable. The observability matrix of Filter 
II becomes 6 and stay at 6 whereas the size of the state vector is 
9. This indicates that the system is not completely observable. It 
means that we cannot fully estimate both the missing rate 
component and the attitude. Eqs. (24) and the discussion that 
follows that equation indicate that the missing rate can be 
observed. Therefore it is concluded that it is the attitude, which 
cannot be fully estimated when Filter II is used. 

5. TEST RESULTS 

Since Filter II can estimate only the rate vector, we present here 
only simulation runs that were carried out using Filter I. 
Simulations were run for different initial conditions and noise 
level using Filter I. Plots that resulted from a typical run are 
presented in Figs. 3-8. For this run the initial % angle was 60 

degrees, 8 was 35 degrees and X was 0. The initial estimates 
were zero for all three angles. The true Euler-angle rates were 
2 *(27t)/ 3 600 rad/sec for zero for 5 and 0.928 • (27i)/60 

rad/sec for X . According to Eq. (1), using these initial rates and 
angles, the true initial angular rate components were as follows: 
(D x = 0.002 rad/sec co y = 0 rad/sec and co z = 0.094 rad/sec. The 

estimated values of the angular velocity were zero for all three 
components. The one-sigma gyro measurement noise was 0.01 
deg/sec and that of the SS was 0.25 degrees. In each figure we 
see the true state and superimposed on it is the estimate of the 
state. Underneath this plot there is a plot of the estimation error. 
In this run £ is estimated quite well, but this is not always the 


case. The observability of this angle is quite poor. Filter II 
was also run but, as expected from the observability test, the 
three attitude angles were not observable. 




Fig. 3: The x-component of the angular velocity and its 
estimation error. 




Fig. 4: The y-component of the angular velocity and its 
estimation error. 



Time [sec] 


Fig. 5: The z-component of the angular velocity and its 
estimation error. 
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Fig. 7: The true and estimated 5 angle. 

6. CONCLUSIONS 

In this paper we considered a spacecraft that uses two two- 
degrees of freedom gyros and two vector measuring devices 
like a SS for measuring the rate and the attitude of the 
spacecraft. We wanted to investigate the possibility of 
estimating the spacecraft full rate vector and attitude if one 
gyro and one vector-measuring device fail simultaneously. 
In our analysis we proposed two filters for estimating the 
desired variables and carried on an observability study for 
both filters. We found that the variables were completely 
observable when one of the filters was used, and was not 
completely observable when the other filter was used. We 
tested our conclusions through simulations and found that 
indeed Filter I can estimate all states however, one of the 
attitude angles was poorly observable. As expected, Filter II 
was unable to estimate the attitude angles. 
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